###########################
# 用于closingPose格式
###########################

std_msgs/Header header
geometry_msgs/Point position
geometry_msgs/Quaternion orientation
uint32 closing_frame_index
uint32 current_frame_index

